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Substitute Specification 

DESCRIPTION 

GUIDING DEVICE FOR GUIDING VEHICLE TO TARGET 
PLACE BY CONTROLLING THE STEERING ANGLE 

This is a 371 national phase application of 
PCT/JP2004/010454 filed 15 July 2004, claiming priority 
to Japanese Patent Application No. 2003-200574 filed 23 
July 2003, the contents of which are incorporated herein 
by reference, 

TECHNICAL FIELD FIELD OF THE INVENTION 

The present invention relates to a guiding 
device for a vehicle that guides the vehicle to move to a 
target position by estimating the current position of the 
vehicle at least based on a steering angle. 

BACKGROUND ART BACKGROUND OF THE INVENTION 

A guiding device disclosed in JP02-308313 A 
guides a vehicle to move to a target position set by a 
user on a setting screen, in which the guiding is carried 
out by creating in real time a target track (orbit) from 
the current position of the vehicle to the target position 
while estimating the current position of the vehicle, and 
by controlling a steering angle based on the created 
target track. 

A guiding device disclosed in JP10-264839 A 
estimates the current position of the vehicle based on 
respective wheel speeds detected by wheel speed sensors 
and a yaw rate detected by a yaw rate sensor and judges 
whether the estimated current position of the vehicle 
departs from a target track. If the estimated current 
position departs from the target track, steering angles of 
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the wheels are controlled according to the departure 
amount in order to correct the departure from the target 
track. 

In order to guide a vehicle to a target 
5 position, it is required to monitor in real time a 

relationship between the current position of the vehicle 
and the target track during movement of the vehicle. This 
means that estimation of the current vehicle position 
plays an important role. Generally, the estimation of the 

10 current vehicle position is based on a controlled steering 
angle and a movement amount (moving distance) of the 
vehicle, that are detected, for instance, by a yaw rate 
sensor and a wheel speed sensor as in the aforementioned 
prior art. However, even in the case of steering angle 

15 being controlled precisely according to target steering 
angles, there is. a difference between the estimated 
vehicle position and the actual vehicle position. The 
difference cannot be detected by a system, because 
steering angle is controlled precisely according to target 

20 steering angles. As a result of this, the difference is 
not corrected for and thus the vehicle is guided to the 
wrong. Therefore, it is desired to find the main factors 
causing such differences and compensate for the 
differences in order to improve the accuracy of the 

25 guiding control. 

DISCLOSURE OF INVENTION SUMMARY OF THE INVENTION 

Therefore, it is an object of the present 
invention to provide a guiding device that guides a 
30 vehicle based on more accurate estimated vehicle positions 
and a vehicle position estimating device that estimates a 
vehicle position more accurately. 

In order to achieve the above-mentioned objects, 
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according to one aspect of the present invention a guiding 
device for guiding a vehicle to a target position by 
controlling a steering angle while estimating the vehicle 
position at least based on a steering angle value is 
5 provided, which is characterized in that, in estimating 
the vehicle position, a slowing operation with respect to 
a change in a moving distance of the vehicle is applied to 
a turning curvature that is estimated based on the 
steering angle value. 

10 According to this aspect of the present 

invention, it is possible to precisely estimate the 
vehicle position by slowing the turning curvature, which 
is estimated based on the steering angle value, with 
respect to a change in the moving distance of the vehicle., 

15 Here, it is noted that the slowing operation with respect 
to a change in the moving distance of the vehicle is not a 
slowing operation with respect to a change in time. The 
moving distance of the vehicle corresponds to the distance 
over the moving trajectory of the vehicle, that is, the 

20 distance traveled. The slowing operation is not 

necessarily applied to the turning curvature that has been 
estimated. That is to say, it may be applied at any stage 
of a turning curvature estimating process. The steering 
angle value, which is used in the estimating process, may 

25 be a controlled steering angle (i.e., a target steering 

angle) . However, preferably, the steering angle detected 
by the steering angle sensor is used, because there is a 
possibility that the steering angle has not been 
controlled precisely according to the intent of the 

30 steering angle control. 

In this aspect of the present invention, the 
degree of slowing in the slowing operation is controlled 
based on detection of changes in characteristics of a tire 
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and/or on detection of the friction coefficient of a road. 

According to another aspect of the present 
invention a vehicle position estimating device is provided, 
comprising: a detector for detecting a moving distance of 
5 a vehicle; a change amount calculator for calculating an 
amount of a change in the direction of the vehicle every 
small moving distance based on a steering angle value; and 
a vehicle position estimator for estimating the position 
of the vehicle based on the amount of the change in the 
10 direction of the vehicle calculated by the change amount 
calculator; wherein in calculating the amount of the 
change in the direction of the vehicle , the change amount 
calculator applies a slowing operation, with respect to a 
change in the moving distance of the vehicle, to a turning 

i 

15 curvature that is estimated based on the steering angle 
value . 

According to this aspect of the present 
invention, it is possible to precisely estimate the 
vehicle position by slowing the turning curvature, which 
20 is estimated based on the steering angle value, with 

respect to a change in the moving distance of the vehicle. 

Other objects, features and advantages of the 
present invention will become more apparent from the 
following detailed description when read in conjunction 
25 with the accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a block diagram of a system 

configuration of a guiding device 10 for a vehicle 
30 according to one embodiment of the present invention. 

Fig. 2 is an image of an example of a touch 

switch panel for setting a target-parking position 

displayed on the display 22. 
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Fig. 3 is a block diagram for showing functions 
of the PARKING-ASSIST ECU 12. 

Fig. 4 is a graphic example of a turning 
characteristic map. 
5 Fig. 5 graphically shows a relationship between 

the estimated trajectory of the vehicle and the actual 
trajectory of the vehicle. 

Fig. 6 graphically shows a relationship between 
the estimated turning curvature without consideration of 
10 the dynamic delay and the actual turning curvature. 

Fig. 7 is a block diagram of the vehicle 
position estimating section 40. 

BEST MODE FOR CARRYING OUT THE INVENITON DETAILED 

15 DESCRIPTION 

Hereafter, the preferred embodiments according 
to the present invention are explained with reference to 
the drawings . 

Fig. 1 shows a system configuration of a 

20 guiding device 10 for a vehicle according to one 

embodiment of the present invention. As shown in Fig. 1, 
the guiding device 10 has an electronic control unit 12 
for assisting parking operations of the vehicle (hereafter 
referred to a PARKING-ASSIST ECU 12). The PARKING-ASSIST 

25 ECU 12 is a microprocessor that includes a CPU, a ROM, a 

RAM, etc., which are interconnected via appropriate buses. 
In the ROM is stored the computer readable programs to be 
carried out by the CPU or data (specifications) of the 
vehicle, such as a length L of the wheelbase. 

30 To the PARKING-ASSIST ECU 12 are connected a 

steering angle sensor 16 for detecting the steering angle 
of the steering wheel (not shown) , and a vehicle speed 
sensor 18 for detecting the speed of the vehicle, via 
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appropriate buses such as a CAN (Controller Area Network) 
or a high-speed communication bus. The vehicle speed 
sensor 18 may be wheel speed sensors provided on 
individual wheels, each of which generates pulse signals 
5 according to a rotating speed of the corresponding wheel. 

To the PARKING-ASSIST ECU 12 are also connected 
a reverse shift switch 50 and a parking switch 52. The 
reverse shift switch 50 outputs an ON signal when a shift 
lever is shifted to the reverse position and otherwise 

10 outputs an OFF signal. The parking switch 52 is provided 
in the cabin of the vehicle so as to allow a user in the 
cabin to operate it. The parking switch 52 outputs an OFF 
signal in its normal state and outputs an ON signal when 
operated by the user. The PARKING-ASSIST ECU 12 

15 determines whether the vehicle is in a state of rolling 
backward based on the output signal of the reverse shift 
switch 50 , and determines whether the user needs 
assistance in parking the vehicle based on the output 
signal of the parking switch 52. 

20 To the PARKING-ASSIST ECU 12 are also connected 

a back monitoring camera 20 disposed at the center of a 
rear bumper and a display 22 provided in the cabin. The 
back monitoring camera 20 is a CCD camera, which images a 
scene behind the vehicle with a predetermined viewing 

25 angle. The back monitoring camera 20 sends the video 
signal representative of the captured images to the 
PARKING-ASSIST ECU 12. Then, on the display 22 are 
displayed the captured image and a touch switch panel for 
setting a target-parking position (see Fig. 3) . A user 

30 operates the touch switch panel on the display 22 and 

adjusts the position of a pictorial display like a parking 
frame (shown by broken lines) superposed on the captured 
image with respect to an actual parking frame (shown by 
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solid lines) . In this way, when the position of the 
pictorial display of the parking frame is confirmed, the 
PARKING-ASSIST ECU 12 recognizes a target-parking position 
based on the position of the pictorial display in the 
5 screen of the display 22. 

To the PARKING-ASSIST ECU 12 is connected a 
steering system ECU 30 for controlling the steering system 
of the vehicle via an appropriate bus. During the 
parking-assist control, the PARKING-ASSIST ECU 12 sends 

10 control signals representative of the target steering 

angles, which are determined as described below in detail, 
to the steering system ECU 30. The steering system ECU 30 
controls a motor 32 for rotating a steering shaft in 
response to the control signals so as to implement the 

15 target steering angles. 

Fig. 3 is a block diagram for showing functions 
of the PARKING-ASSIST ECU 12. The PARKING-ASSIST ECU 12 
includes a vehicle position estimating section 40 and a 
target track calculating section 42. As described below 

20 in detail, the vehicle position estimating section 40 

estimates the position of the vehicle during the parking- 
assist control based on the output signals of the steering 
angle sensor 16 and the vehicle speed sensor 18. The 
target track calculating section 42 calculates a target 

25 track based on the difference between the target track 

previously calculated and the vehicle position estimated 
by the vehicle position estimating section 40, and 
determines a target steering angle at the vehicle position 
based on the calculated target track. The steering system 

30 ECU 30 controls a motor 32 according to the target 

steering angle determined in this way. It is noted that 
the target track calculating section 42 may calculate the 
target track every predetermined moving amount of the 
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vehicle. In order to certify the later correction of the 
target track, the initial calculation of target track may 
be constrained by a certain turning curvature less than a 
maximum turning curvature (e.g., 90 percent of the maximum 
5 turning curvature) of the vehicle. This helps to provide 
smooth steering control free from user discomfort. 
However, the present invention is not limited to this kind 
of a target track calculating method. For example, the 
present invention can be applied to a parking-assist 

10 control where the vehicle is forced to guide based on the 
initially calculated target track without recalculating 
the target track. 

Here, in advance of a description of a vehicle 
position estimating method according to the present 

15 invention, a conventional method is described. 

Conventionally, the vehicle position is estimated using 
the following formulas: 

0 = jg(Str(p)) dp ( 1 ) 

X = X o -^sm0dp (2) 

20 Y = Y o~ jcostf dp (3) 

where X and Y are coordinate values of the vehicle 
position in two dimensions with respect to the center of 
the rear axle of the vehicle. X 0 and Y 0 are initial 
values, that is, the coordinate values at the beginning of 

25 the parking-assist control. dp is a small moving 

distance of the vehicle that is derived by integrating the 
output signals (pulses) of the vehicle speed sensor 18. 
0 is a change in an angle (direction) of the vehicle 
generated at the turning of the vehicle. g(Str(p)) in the 

30 formula (1) is a turning curvature that is derived from a 
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predetermined turning characteristic map (look-up-table) , 
as shown in Fig. 4, using a steering position Str(p) 
obtained from the steering angle sensor 16 as an argument. 
The turning characteristic map shown in Fig. 4 is made 
5 based on the actual turning curvatures measured by RTK-GPS 
(Real Time Kinematic-Global Positioning System) at the 
orbiting (turning) of the vehicle with constant steering 
angles set at regular intervals. 

Fig. 5 shows test results in which the 

10 relationship between the trajectory of the vehicle 

calculated by the aforementioned traditional vehicle 
position estimating method (indicated by the one-dot chain 
line) and the trajectory of the vehicle actually measured 
by the RTK-GPS (indicated by solid line) is shown. It can 

15 be understood from Fig. 5 that the trajectory of the 
vehicle calculated according to the aforementioned 
traditional estimating method departs from the actual 
trajectory. This departure from the actual trajectory 
(i.e., error of estimation of the vehicle position) cannot 

20 be detected by the system (the PARKING-ASSIST ECU 12) 
without sensing the actual vehicle position. 

As a result of research and tests, the 
inventors of the present invention found that a dynamic 
delay of a turning curvature due to torsional deformation 

25 of tires is the main factor that causes the aforementioned 
error of estimation of the vehicle position. When the 
tire is subject to torsional deformation, the traveling 
direction of the vehicle doesn't strictly correspond to 
the steering directions of the wheels, and the actual 

30 turning curvature doesn't follow the estimated turning 
curvature derived based on the output signal of the 
steering angle sensor 16 until the torsional deformation 
is relieved by the further movement of the vehicle. 
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Fig. 6 is a conceptual graph in which the 
relationship between the estimated turning curvature 
g(Str(p)) without consideration of the dynamic delay and 
the actual turning curvature. As the steering position 
5 Str(p) changes as a function of a moving distance p as 

shown in the upper part of Fig. 6, the turning curvature 
g(Str(p)) without consideration of the dynamic delay 
changes linearly in response to the change of the Str(p) 
as indicated by the broken lines in the lower part of Fig. 

10 6. On the other hand, it is predicted that the actual 
turning curvature responds to the change of the Str(p) 
with a delay due to the torsional deformation of the tire, 
as indicated by the solid line in the lower part of Fig. 6. 

For this reason, according to the present 

15 invention, the vehicle position estimating calculation 

applies "a slowing (smoothing) operation" to the estimated 
turning curvature g(Str(p)) derived from the output signals 
of the steering angle sensor 16, whereby the dynamic delay 
of the turning curvature is compensated for. The "slowing 

20 operation" used hereby indicates not a general slowing 
operation with respect to time but a slowing operation 
with respect to the change in the moving distance. More 
specifically, The "slowing operation" is to identify 
(mathematically express) the dynamic delay of the turning 

25 curvature which occurs, for instance, in the case of the 
tire having the torsional deformation where the direction 
of the vehicle doesn't correspond to the steering angle of 
the tire and the actual turning curvature doesn't follow 
the estimated turning curvature until the torsional 

30 deformation is relieved by the further movement of the 
vehicle. Therefore, even if time goes by, the "slowing 
operation" is not applied when the moving distance is zero. 
This idea is based on the fact that the restoration of the 
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torsional deformation of the tire occurs not because of 
the passage of time but because of the rotation of the 
tire, that is, the movement of the vehicle. 

In this embodiment, based on the findings that 
5 "the dynamic delay of the turning curvature can be 

identified using a formula that expresses first-order 
delay with respect to a moving distance p", the following 
formula of first-order delay is used to apply the "slowing 
operation 7 ' to the estimated turning curvature g(Str(p)) 
10 derived from the output signals of the steering angle 
sensor 16, as shown in the block diagram of Fig. 7. 

^fi- = -M ■ y{p) + N ■ g(Str(p)) 
dp 

Specifically, the vehicle position estimating 
section 40 according to this embodiment obtains a turning " 

15 curvature y(p) with consideration of the aforementioned 
dynamic delay by multiplying the input g(Str(p)) by a 
coefficient N, subtracting the feedback output y(p) 
multiplied by a coefficient M from the N ■ g(Str(p)) , and 
then integrating this value N g(Str(p))-M • y(p) . Then, the 

20 vehicle position estimating section 4 0 adopts the 

estimated turning curvature y(p) with consideration of the 
delay instead of the estimated turning curvature g{Str(p)) 
without consideration of the delay in the formula "(1) and 
then estimates the vehicle position (X, Y) using the 

25 formulas (2) and (3) . The vehicle position estimating 
section 40 may do this estimating calculation of the 
vehicle position whenever the vehicle moves by a 
predetermined moving distance. In this case, the change 
of the angle of the vehicle 6 may be calculated, for 

30 instance, by multiplying the turning curvature y(p) 

obtained every 0.01 m of moving distance by that small 
moving distance 0.01, and integrating these multiplied 
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values obtained every 0.05 m of moving distance. 

The coefficients N and M are identified such 
that the trajectory of the vehicle position (X, Y) 
obtained as mentioned above corresponds to the actual 
5 trajectory (see Fig. 5) . In Fig. 5, the trajectory of the 
vehicle position, which is estimated using the identified 
coefficients N and M, is shown by the dotted line. As 
shown in an enlarged part of Fig. 5, the trajectory 
without consideration of the delay (indicated by the one- 
10 dot chain line) departs from the actual trajectory 

(indicated by a solid line) as above-mentioned while the 
trajectory with consideration of the delay substantially 
corresponds to the actual trajectory. This shows that the 
identification of the coefficients N and M is implemented 
15 successfully by the first-order delay formula. 

It is noted that the estimated turning 
curvature g(Str(p)) to be input to the vehicle position 
estimating section 40 may be derived by using the turning 

■ 

characteristic map as shown in Fig. 4 predefined based on 
20 measurement, based on the output Str(p) of the steering 
angle sensor 16. Alternatively, the estimated turning 
curvature g(Str(p)) may be derived simply by a fixed 
overall gear ratio rj and a length L of the wheelbase 
(i.e., estimated turning curvature=iS'/r(j?)/ L • 77 ) . 
25 According to the test results of side-by-side 

type parking and end-to-end type parking, the error in 
estimation of the vehicle position in the case of applying 
the "slowing operation 7 ' is significantly reduced with 
respect to that in the case of not applying the "slowing 
30 operation" . 

Further, even in the case of changing 
conditions on a parking trajectory, a load, the air 
pressure of a tire, and the degree of abrasion of a tire, 
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the error is significantly smaller when the "'slowing 
operation" applied. 

However, in this embodiment, in order to 
further reduce the error, it is also possible to control 
5 "a degree (amount) of slowing" according to changes in 
characteristics of a tire, such as changes in the degree 
of abrasion, temperature and air pressure of a tire, and 
the like. For example, the "degree (amount) of slowing" 
may be increased as the air pressure of the tire decreases, 

10 based on detection of the air pressure of the tire by air 
pressure monitoring means. 

Further, it is found from the test results by 
the inventors of the present invention that the abrasion 
of the tire has a larger impact on the error than other 

15 factors, such as the speed of the vehicle, the load 

carried by the vehicle, and the air pressure of the tire. 
Thus, the "degree of slowing" (i.e., the coefficients N 
and M) may be varied according to the degree of tire 
abrasion. For example, the "degree (amount) of slowing" 

20 may be decreased as the total traveling distance of the 
vehicle increases, based calculating the total traveling 
distance of the vehicle after exchange of a tire. 

Similarly, the "degree of slowing" (i.e., the 
coefficients N and M) may be varied according to the 

25 estimated friction coefficient of the road. In this case, 
the friction coefficient of the road may be estimated 
based on the difference in rotation between wheels to 
which braking is applied and driven wheels. Then, the 
influence of the wetness of the road may be taken into 

30 account based on detection by a rainfall sensor or the 
presence or absence of operation of windshield wipers. 
Further, the friction coefficient can be estimated based 
on the predetermined vibration components of the wheel 
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speed derived from the output signals of the wheel speed 
sensors, as described in JP11-78843. Further, the 
friction coefficient can be estimated based on the damping 
characteristics of the response components of the wheel 
5 speed when the braking load changes in a stepwise manner, 
or estimated based on the back-scattered wave of an 
ultrasonic wave, a millimeter wave and the like emitted 
toward the forward area of the road. 

It is also possible to vary the "degree of 

10 slowing" (i.e., the coefficients N and M) according to the 
parameters related to the degree of the deformation of the 
tire. For example, the "degree of slowing" may be 
increased in the case of the absolute steering angle 
exceeding the predetermined threshold or the "degree of 

15 slowing" may be increased with the increase in the 

absolute steering angle. Further, the "degree of slowing" 
may be varied according to a rate of change in the 
absolute steering angle (i.e., a steering speed). 

The present invention is disclosed with 

20 reference to the preferred embodiments. However, it 

should be understood that the present invention is not 
limited to the above-described embodiments, and variations 
and modifications may be made without departing from the 
scope of the present invention. 

25 For example, since steering control free from 

high-frequency components (gain is not set high) is 
implemented in the aforementioned embodiment, the "slowing 
operation" can be carried out by using the first-order 
delay formula as above-mentioned. However, the "slowing 

30 operation" may also be carried out by using second-order 
delay formula. 

Further, in the aforementioned embodiment, the 
estimated turning curvature g(Str(p)) is first derived by 
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using the turning characteristic map based on the steering 
position Str(p) detected by the steering angle sensor 16, 
and then the ""slowing operation'' is applied to the 
estimated turning curvature g(Str(p)) . However, it is also 
5 possible to first apply the '"slowing operation'' to the 
steering position Str(p) detected by the steering angle 
sensor 16 and then derive the g(Str\p)) by using the 
turning characteristic map based on the steering position 
Str'(p), that has been subject to the "slowing operation". 

10 In other words, the "slowing operation" may be applied at 
any stage of the turning curvature calculating process. 

Further, in the aforementioned embodiment, the 
vehicle position is estimated based on the steering 
position Str(p) of the steering angle sensor 16, 

15 considering the fact that the target steering angle does 
not necessarily correspond to the steering position Str(p) 
of the steering angle sensor 16 at the corresponding time. 
However, the vehicle position may be estimated based on 
the target steering angle instead of the steering position 

20 Str(p) of the steering angle sensor 16. 



CLAIMS 



1 . A guiding device for guiding a vehicle to a 
target position by controlling a steering angle while 
estimating a vehicle position at least based on a steering 
angle value, characterized in that, in estimating the 
vehicle position, a slowing operation with respect to a 
change in a moving distance of the vehicle is applied to a 
turning curvature that is estimated based on the steering 
angle value. 

2. The guiding device as claimed in claim 1, 
wherein a degree of slowing in the slowing operation is 
controlled based on detection of changes in a 
characteristic of a tire. 

3. The guiding device as claimed in claim 2, 
wherein the characteristic of the tire includes a degree 
of abrasion of a tire, temperature of a tire or air 
pressure of a tire. 

4. The guiding device as claimed in claim 1, 
wherein a degree of slowing in the slowing operation is 
controlled based on a degree of abrasion that is estimated 
by calculating a total traveling distance of the vehicle. 

5. The guiding device as claimed in claim 1, 
wherein a degree of slowing in the slowing operation is 
increased when an absolute steering angle exceeds the 
predetermined threshold. 

6. The guiding device as claimed in claim 1, 
wherein a degree of slowing in the slowing operation is 



increased as an absolute steering angle increases. 

7. The guiding device as claimed in claim 1, 
wherein a degree of slowing in the slowing operation is 
controlled based on detection of a friction coefficient of 
a road. 

8. A vehicle position estimating device, 
comprising: 

a detector for detecting a moving distance of a 

vehicle; 

a change amount calculator for calculating an 
amount of a change in a direction of the vehicle every 
small moving distance based on a steering angle value; and 

a vehicle position estimator for estimating a 
position of the vehicle based on the amount of the change 
in the direction of the vehicle calculated by the change 
amount calculator; wherein 

in calculating the amount of the change in the 
direction of the vehicle, the change amount calculator 
applies a slowing operation with respect to a change in a 
moving distance of the vehicle to a turning curvature that 
is estimated based on the steering angle value. 
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ABSTRACT 

A guiding device is disclosed for guiding a 
vehicle to a target position by controlling the steering 
5 angle while estimating the vehicle position at least based 
on a steering angle value, characterized in that, in 
estimating the vehicle position, a slowing operation with 
respect to a change dp in a moving distance of the 
vehicle is applied to a turning curvature g(Str(p)) 
10 estimated based on the steering angle value in order to 

compensate for the delay due to tire deformation, whereby 
the delay-compensated turning curvature y(p) is obtained. 
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